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(54) GAIT GENERATING DEVICE FOR LEG TYPE MOVING ROBOT 



(57) In a gait generation system for a legged mobile 
robot, in particular a legged mobile robot having a body 
and a plurality of legs links each connected to the body 
through a joint, it is configured such that gaits compris- 
ing motion parameters and floor reaction force parame- 
ters are varied freely on a real-time basis during 
walking. In order to effect this, various standard gaits 
have been prepared on an off-line computer and an 
approximated value such as a weighted average thereof 
is calculated in response to a demand for gait, and gaits 
are generated. Moreover, the gaits are corrected using 
an inverted pendulum model such that positions and the 
velocities are continuous at the boundary of the gaits. 
With the arrangement, it becomes possible to generate 
gaits having the floor reaction force freely on a real-time 
basis to effect a stride or turning angle as desired. It 
also becomes possible to make the displacements and 
velocities of various portions of the robot continuous at 
the boundary of the gaits. In addition, it becomes possi- 
ble to control the legged mobile robot based on the gaits 
thus generated on a real-time basis. 
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Description 

TECHNICAL FIELD TO WHICH THE INVENTION RELATES TO 

r0001 1 T*e present invention relates to a gait generation system of a legged mobile robot, and more particularly to 
a system for generating or determining a gait freely on a real-time bas.s. 

BACKGROUND ART OF THE INVENTION 

££££ TuslX' TH'e data are then tcaded » . memory =. , mtoocon^rfer mourned on the 

robot v»hich outputs the data successively to be Pressed toja «*na (Japanese Patent Publica- 

basis. 

DISCLOSURE OF THE INVENTION 
,0008] -rdertoa™ 

of a legged mobile robot having at least a b ^ a ^ a Qf standard gaits , for at , ea st one walking step, 

comprising standard gait stor.ng means f°r stor,ng.j " ™^ r * ^ a f^SSion force, gait demanding means for 

JSST "TTSS&SSSKS- ga» genera*, means oenerates ft. approximated oat, by using e parameter 
■ tr^S^tSC'srud ga« general means generates the *PP— << ' «* » <*»**• ' 

5S5T\ is configured such that the perturbation of the one parameter is a perturbation of a horizontal body pcsi- 
[001 5] It is conf igured such the relationship is described by a linear model. 
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[001 6] It is configured such that the relationship is described by an inverted pendulum model. 

[001 7] It is configured such that the relationship is described by time-series tabulated data 

[001 8] It is configured such that said gait generating means generates the approximated gait without considering 

the parameter if it is under a predetermined condition. ~ 

[001 9] It is configured such that said gait generating means includes joint angle command calculating means for 

calculating a joint angle command of the robot based on the generated gait, and joint controlling means for controlling 

the joint of the robot such that it traces the calculated joint angle command. 

[0020] It is configured such that said joint angle command calculating means includes detecting means for detect- 
ing a state of the robot, and correcting means for correcting a position and a posture of the robot in response to the 
effected 1 Stat6 ' ^ ° alCU,ateS * hS j ° int anQ ' e command such ^at the corrected position and the orientation are 

BRIEF DESCRIPTION OF THE DRAWINGS 
[0021] 

Figure 1 is a schematic view showing an overall configuration of a gait generation system of a legged mobile robot 

according to the present invention; w 

Figure 2 is a block diagram showing details of a control unit of a biped robot illustrated in Figure 1 ■ 

to Ihe^resen^^^ Sh ° Wi " 9 ° peration of the gait system of a legged mobile'robot according 

ingTth?p^i JESS? *" * ^ ^ 96n6rati ° n ° f 3 ^ m0bHe r0bot *™+ 

Figure 5 is an explanatory view showing the free leg position and orientation in standard gait No 0 from amona the 
standard gaits used in the gait generation shown in Figures 3 and 4; 9 
Figure 6 is an explanatory side view showing the feet trajectory in standard gait No.O illustrated in Figure 5- 
illSated^n a F t ! g n u e re C 5 art ^ trajeCt ° ry ° f ^ ZMP (in the ^"ordinate or direction) in standard gait No.0 

2^ S h S I" explanat ° ry view showing the free ,e 9 P^rt'on and orientation in standard gait No. 1 from among the 
standard garts used in the gait generation shown in Figures 3 and 4- 

inusfrated1n a Figu e e C 8 art Sh0Wi " 9 * ^ ^ ^ ^ X ' coorcJinate or direction ) standard 9ait No. 1 

Figure 10 is an explanatory view showing the free leg position and orientation in standard gait No. 2 from among 
the standard gaits used in the gait generation shown in Figures 3 and 4- 

Sstrated 'in FigureTof *" ***** * *" ^ °" ^ X - coordinate or direction > ■" standard gait No.2 

Figure 12 is an explanatory view showing the free leg position and orientation of a demanded gait demanded in the 
gait generation shown in Figures 3 and 4; «»u«u me 

uL2 'in Figur^ *" ****** " *" °" *" X - COOrdinate or direction ) in *» demanded gait 

Figure 1 4 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 4- 

Figure 1 5 is an explanatory view explaining the operation of the flow chart of Figure 14- 

Figure 16 is an explanatory view explaining, similarly to Figure 15. the operation of the flow chart of Figure 14 

rl/rL Z I IZ T f fT 9 the subroutine of the calculation of instantaneous values of the desired 'gait 
referred to in the flow chart of Figure 4; 

rinHnJ^t 3 !5" C *IT Sh ?"' nB 3 double - |e 9 compliance control proposed earlier by the applicant which will be 
conducted based on the gait generated in the gait generation shown in Figures 3 and 4- 

r^Z -,? ,S , 3 IT char * f ow, u n 9 tne subroutine of calculating a manipulated variable of ihe double-leg compliance 
control illustrated in the flow chart of Figure 18; h»™«w» 

SK^V Tit'" f ' OW Chart ' Simi ' ar *° Fi9Ure 4 ' but Showing the °P eration of the system according to a second 
embodiment of the present invention; 

Figure 21 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 20- 

Figure 22 is a flow chart showing the subroutine of the calculation of instantaneous values of the desired gait 

referred to in the flow chart of Figure 20; aesireo gait 

Sh^^lnt IT" "° W ? 3rt ' Simi ' ar t0 R9Ure 4 ' but Sh0wing the °P eration of the system according to a third 
embodiment of the present invention; 

Figure 24 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 23- 

Figure 25 ,s a ffow chart showing the subroutine of the calculation of instantaneous values of the desired gait 
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referred to in the flow chart of Figure 23; 

Figure 26 is a main flow chart, similar to Figure 4, but showing the operation of the system accord.ng to a fourth 
embodiment of the present invention; .^mont «( «.« 

Figure 27 is a time chart showing the gait such as a body position generated .n the fourth embod.ment of the 

KTat! 2e chart showing the trajectory of the ZMP (in the X-coordinate or direction) for explaining how to 

accord the conditions of boundary with each other referred to in the flow chart of Figure 26; 

Rg^re 29 Is a time chart showing the trajectory of the ZMP (in the X-coordinate or direction) for expla,n,ng the oper- 

F?g"a™ 

the ooeration illustrated in the flow chart of Figure 26; 

RguTe 32 is a time chart showing the trajectory of the ZMP (in the X-coordinate or direcbon) for similarly expla.n,ng 
the operation illustrated in the flow chart of Figure 26; 

Figure 33 is a flow chart showing the subroutine of gait mixing referred to in the flow chart <rf Figurs ,26; 

Figure 34 is a flow chart showing the subroutine of the calculation of instantaneous values of des.red gart referred 

^^^JSSSSZ the gait generated in the fourth embodiment illustrated in the flow chart of Figure 

Rgure 36 is a main flow chart, similar to Figure 4. but showing the operation of the system according to a fifth 

embodiment of the present invention; „^u^i;^^. 

Figure 37 is an explanatory view showing an inverted pendulum model used in the fifth embodiment 

Figure 38 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 36; 

Figure 39 is a flow chart showing the subroutine of the calculation of instantaneous values of the desired ga.t 

rpf erred to in the flow chart of Figure 36; ... 

F fgure40 is a main flow chart, similar to Figure 4, but showing the operation of the system according to a s.xth 

embodiment of the present invention; ^ . ,. An . 

Figure 41 is a time chart showing the operation of the sixth embodiment illustrated in figure 40, 

Figure 42 is a flow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 40;_ 

Figure 43 is a flow chart showing the subroutine of the calculation of instantaneous values of the desired gait 

referred to in the flow chart of Figure 40; 

Figure 44 is a time chart showing the operation illustrated in the flow chart of Figure 40; 

Figure 45 is a block diagram, similar to Figure 3, but showing the configuration and operation of the system accord- 

inq to a seventh embodiment of the present invention; .. , . 

Figure 46 is a main flow chart showing the operation of the system according to the seventh embod.ment of the 

Ftau^V" is a ftow chart showing the subroutine of gait mixing referred to in the flow chart of Figure 46; 

Figure 48 is a flow chart showing the subroutine of the calculation of instantaneous values of the des.red ga.t 

referred to in the flow chart of Figure 46; and 

Figure 49 is an explanatory view showing the body position in the gait generated by the gart generation system of 
a legged mobile robot according to the present invention. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

[00221 The gait generation system of a legged mobile robot according tothe present invention will be explained with 
eference to the accompanied drawings. A biped robot is taken as an example of a legged mobile robot _ 
[oSS] Figure 1 is a schematic view showing an overall conf iguration of the system including a biped robot 1 accord- 

SSSr TSsS'rtTthe figure, the robot 1 has a pair of laterally spaced leg links 2 each composed of^joint, 
n a s rnple representation, each of the joints is represented by an electric m f>7 hl * artu ^ 
include arranged successively downward, a pair of joints 10R. 10L (the right-hand joint is indicated by R and the left- 
hand ioint by L) for rotating legs with respect to hips, a pair of joints 1 4R, 1 4L for rolling movement with respect to hips 
Sa £3. within a frontal plane, a pair of joints 12R. 12L for pitching movement with respect to h,ps about a Y- 
axSwrthin a sagittal plane, a pair of knee joints 16R. 16L for pitching movement with respect to knees, a pa r of jo.nte 
SS." 8L tor prtching movement with respect to ankles, and a pair of joints 20R 20L for rolling movement w.th respect 

\r\ £3nHe^ 

[0025] The robot 1 is provided with feet 22R, 22L and has a body (trunk) 24 as its uppermost portion which houses 
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^ PWiT'iTwff C T PriSi " 9 mi ^ocomputers which will be described later with reference to Figure 2. The joints 
10R(L), 12R(L), 14R(L) make up h,p jo.nts, and the joints 18R(L). 20R(L) make up ankle joints. The hip joints and knee 

Sfdlen^ 

™ te 7 u ;S^ Wn9 r0b0t 1 t0 W3,k arMy ^ 3 ~ona, environment. (,n ESSSZ* 
[0027] It should be noted that, throughout the description, the position and velocity of the body 24 are used to reo- 
rePreS6ntatiVe POSiti ° n SUCh 35 the pps «- °< *he -nter of gravity oftoe body Z and (diXmen*) 

[0028] As shown in Figure 1, a known six-axis force and torque sensor 44 is disposed below the ankle joints for 
measuring three directional components Fx, Fy. Fz of force and three directional component kTiI ^Mz of tomte o 
moment thereby to detect whether the foot 22R(L) has landed or not. or if a load or force is acting 'ZVer^^oZ 
the foot assembly when ,t contacts the floor. The body 24 has an inclination sensor 60 for detecting fephVo^S 
.n the frontal plane w,th respect to a Z-axis (the direction of gravity) and its angular velocity S and ateo a tnt in Z 

IT~££* ""I reSPe ^° th6 , Z - a3dS a0d itS an9U ' ar ve,OCity motors o7 are coupS 

w* respective rotary encoders for detecting angular displacements of the electric motors P 

on £ , Altn _ OU9 u h not shown in Fi 9 ure 1 - the robot 1 is configured to have a joystick 62 at an appropriate oosition 

[0030] Figure 2 is a block diagram which shows the details of the control unit 26, which is comprised of microcom 

t P ransmiS P tf T ? "ST", 6 °" *" are COnvened * an ™ convener *> rntc dfcS T£l w S TaTe 

transmitted hrough a bus 72 to a RAM 74. Output signals from the rotary encoders that are disposed I adacert to toe 
25 respechve electnc motors are transmitted through a counter 76 to the RAM 74 aisposea adjacent to the 

[0031 ] The control unit 26 includes first and second calculators 80. 82 comprising CPUs The first calculator 80 

rom sT, 3 .^ t ee J y or L a rea, " time basis durin9 wa,kin9 usina standa * 9aits p^ 9 * bS^SSSSSTh" 

ROM 84. calculates des.red ,o,nt angles based on the generated gait, and outputs to the RAM 74 The second caTcl 
tor 82 reads the des.red joint angles and detected values from the RAM 74. and outputs manipulated varS2 ttTrouoh 
r^rT" 86 , and S J r V °- amp,ifierS ,0 the e,6Ctric motors P rovided at *e resp^eToims 

[0032] Rgure 3 is a block diagram which shows the operation of the system according to the present invention in a 
functional manner, while Figure 4 is a flow chart (called a "structured flow chart") showing toe Procedures oToTiJZnn 

"XSg 3 " il,UStra,ed *** dia9fam - ' n ^ SPeCffiCati ° n - the 99it SHT 

Sites a E Sf nin9 * ''I I' 9 f t0 bS 9en6rated b/ thS SyStem ' the present invention ai ™ to provide a system which 
generates a gart on a real-t.me basis as mentioned above. More specifically, the present invention aims to generate a 
gart wNch ,s necessary for conducting the robot posture stability control utilizing the double-leg XS^ce^nZ^o 
posed earher by the applicant in Japanese Laid-Open Patent Application No. Hei 5 (1993) - S5w P °" 

EfZL o I T U "f erstandin 9- the P ostur e Vilify control proposed earlier will briefly be explained In the con- 
trol the error between a desired value and the detected value of the floor reaction force (ZMP) is fXt determined Tr. 

to iP r ov r e b °i d^r t r ecrease the error ' thereby —5 3x2 sjsjes 

is^^s^^'ssr deviated or ^ 80 as to deviate or shm the — < J 

Z d ir/° f Sfy th6 dynamiC ^ Ui,ibrium condition means - *> be more specif*. mTT^^SSSSS 
bernmi n (th f T " ^ 0n the f '°° r at which the secondar V ™ment of the desinSE reason foS 
ofth^ 

ShSr whin v 9raVlty ' S 2er ° except for te vertical component). If they do not accord with each 

zx^:z e ^z the robot ioses dynartc between the resuitant " 

USSn tinn Compliance contro » P ro P° sed this is deliberately utilized to restore stability when the robot is 

T As r s r derstood from the *«* the ^ ™™* «*« should ha ve. !22£!££! n 

Sp Zlm> 'oco-T.ot.on, not only the desired motion pattern, but also the desired floor reaction force pattern ifisMna 
the dynamic equilibrium condition relative to the desired motion pattern satisfying 

thereat a^SH^S! TbZT™ 5 deSM by 3 P ° int * aCtton and *» a force and moment acting 

tnereat. Since the point of act.on can be set at any point, the desired floor reaction force has numerous descriotions 
However. ,f the desired f .cor reaction force is described by taking the aforesaid central point of the SrSf^cTon 
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{0 rce as the point of the action, the moment, acting at the point, of the resu.tant force is zero except for its vertical com- 
ponent + k tr - ortnru nf the cen tral Doint of the desired floor reaction force (which satisfies 

L bTUd in tou o,.he desired nave, as desired vafues in ft. 
W,, Tnerefore, tn. ^-nb^n-jn as. »e desir*. ZMP traieaorv (desired 

„ Ttre desired aa« is. in . broad sens., a M of ft. desired motion trajectories and fn. deslrad .loo, reaCon force 
^e^rX«1s°l%Crrse^ se, of .he d— mo** MM - -h. ™P frai^ry * a 

period of a single walking step. 

c) A series of walking is comprised of a series of gaits. 

rower sense, unless it is mentioned to the contrary. Specially, tie °J™» supporting phase that 

beginning from the initial state of a double- eg support ng phase to the f.nal s ate £g**J* 1 supports its 

follows. Here, needless to say. the double-leg s "ee^^ which the robot supports 

r^iTX^ ■** - sing,e - ,e9 

supporting phase is called the free .eg. while the ^I^Xdesi 2 gart defined above freely and on a real-time 
a oath or to effect high precision positioning. 



30 tions. 



*a a matter of couiae, oondHlon , 
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generated gait can satisfy all of the conditions mentioned above. 

[0048] In particular, when generating the body trajectories satisfying condition 1 ) based on the ZMP trajectory by a 
gait generation algorithm, even when the ranges, suitable for continuous walking, of the body position and velocity at 
the gait end or final state are known, it is difficult to determine the parameters relating to the ZMP trajectory such that 
both the body position and velocity will fall within the range at the gait end. 
[0049] The reasons of the difficulty are as follows. 

Reason 1) The robot body tends to move farther from the ZMP, once initially moved away from the ZMP. This will 
be explained using an inverted pendulum model which approximates the behavior of the robot body. 

If the inverted pendulum's supporting point deviates from the projection point of the center of the gravity of the 
pendulum projected to the floor, the deviation tends to increase, and the pendulum turns over. Even when the pen- 
dulum is turning over, the resultant force of the inertial force and gravity of the inverted pendulum is acting on the 
supporting point (in other words, the ZMP is kept equal to the supporting point, and the resultant force is kept bal- 
anced with the floor reaction force acting through the supporting point. The dynamic equilibrium condition merely 
describes an instantaneous relationship between the inertial force and gravity and the floor reaction force of a mov- 
ing object. 

It is a frequent misconception that continuous robot walking can be ensured if the dynamic equilibrium condi- 
tion is satisfied. However, satisfaction of the dynamic equilibrium condition will not ensure that the robot does not 
lose a stable posture during walking. Just as the center of gravity of the inverted pendulum tends to move farther 
if moved from the position immediately above the supporting point, the center of gravity of the robot tends once 
moved from the position immediately above the ZMP, to move farther therefrom. 

Reason 2) The single-leg supporting phase requires that the ZMP must be within the supporting leg foot sole floor- 
contact area. Due to rigid conditions of constraint such as this, it is difficult to determine the body acceleration and 
deceleration patterns. If the body patterns are determined mainly taking body position into account the velocity 
would tend to be out of range at the gait end, and vice versa. An analogy when driving a vehicle, is to stop the vehi- 
cle at a predetermined stopping position at a designated time, while limiting braking force to within a narrow preset 
range. 

[0050] Thus, it has hitherto been difficult to generate or determine the desired gait parameters or tabulated data 
on a real-time basis, which will satisfy all of the possible gait conditions. The aforesaid prior art techniques described in 
the references hence could not effect free robot walking. 

[0051 ] Based on the above, the system according to the present invention will be explained with reference to Figure 
3. The figure, a block diagram, shows the system in a functional manner so as to facilitate understanding of the opera- 
tion of the system illustrated in Figure 4. 

[0052] In the system illustrated, the gait(s) is generated in a mixed gait instantaneous value generator on the basis 
of a set or group of standard gaits (which have been generated on an offline computer and stored in the ROM 84) in 
such a manner that the generated gait satisfies a demand for gait (such as to change gaits) made on a real-time basis 
during walking. 

[0053] The standard gaits have been prepared by an offline computer by selecting gaits, through trial-and errors 
which ensure a long continuous period of walking up to the final step, without causing the robot body trajectory to 
diverge, and have been stored in the ROM 84. The standard gaits which ensure a long continuous period of walking are 
typically comprised of a series of gaits having a gait to start walking from a standing position, a gait for accelerating the 
walking speed, a gait for constant speed walking, a gait for decelerating the walking speed, and a gait to stop walking 
[0054] The gait is described by gait parameters. The gait parameters are comprised of motion parameters and the 
ZMP parameter (more generally floor reaction force parameter). The "floor reaction force parameter" is used in this 
specification to mean a parameter relating to the floor reaction force pattern with respect to time 
[0055] The ZMP trajectory has a zig-zag pattern, and the ZMP parameter is described in the coordinate of X Y and 
Z (directions) by the positions of the braking points and passing times as is shown in Figure 7. (The ZMP is referred to 
only in the X-coord.nate.) In the mixed gait instantaneous value generator, instantaneous values of ZMP (trajectory) 
™«1 t CUrrent (Current time) control cycle are calculated in a Z MP generator based on the ZMP parameters ' 
nnft I m ° t,0n parameters are comprised of feet (trajectory) parameters and the body (trajectory) parameters 
f « * . L f 6t trajectory P arame *ers are comprised of initial free leg (foot lifting) position and orientation, final free 
eg (foot landing) position and orientation, and the periods or times of the double-leg supporting phase and the single- 
leg supporting phase, etc. Based on these, instantaneous values of the positions (xf, yf, zf) and orientations (0 xf e yf 
e zf) of both feet are determined by a feet trajectory generator in accordance with the technique proposed earlier by the 
applicant m Japanese Laid-Open Patent Applications Hei 5 (1 993) - 31 8,339 and Hei 5 (1993) - 324, 115 Here the word 
orientation" means inclination or direction in space. 

[0058] The body trajectory parameters include parameters defining the body orientation (the direction or inclination 
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of the body 24 in space), the body height (a value in the Z-direction), initial body position (displacement) and velocity, 
etc. 

[0059] Based on the parameters determining the body position and orientation, instantaneous values of the hori- 
zontal position (xb. yb) and orientation (6 xb, 6 yb, 6 zb) of the body are generated in a horizontal body position gener- 
ator in accordance with time functions or the technique proposed earlier by the applicant in Japanese Laid-Open Patent 
Application Hei 5 (1993) - 324,1 15. The body position is, as mentioned earlier, the position of the representative point 
such as the center of mass of the body 24. The height of body zb is determined in a body height determinator using an 
appropriate technique such as that described in a patent application filed by the applicant on the same date as the 
present invention. . 
[0060] Since the legged mobile robot 1 has 1 2 joints as illustrated in Figure 1 , joint angles are deterministically cal- 
culated by an inverse kinematic solution from the obtained feet positions and orientations and the body position and ori- 
entation More specifically, the current desired robot posture is solely determined. (More precisely, the desired feet 
positions and orientations are subject to correction in a double-leg compliance controller and based on the corrected 
values (if corrected), the desired joint angles are calculated.) 

[0061] The gaits are deterministically described by the gait parameters. In this embodiment, however, in order to 
reduce the volume of calculation, standard gait body trajectories have been prepared in advance by an offline computer 
as time-series tabulated data to be stored in memory, whereby data corresponding to the control cycle is successively 
output When the capacity of the ROM 84 is relatively small, it is alternatively possible to approximate the standard gait 
body trajectories using a polynomial and coefficients of the polynomial are stored in memory as a kind of gait parame- 
20 ter, although this does lead to a small approximation error. 

[0062] Hereafter, the standard gaits are further explained. The standard gaits are described in this specification as 
time functions. Each standard gait is described by a set g(t) and f(t) defined as follows. 

g(t): functions describing the motion of the robot. (Specifically, the functions represent the positions and orienta- 
tions of the robot components at time t, more specifically, the motion of the robot is described by the positions and 
orientations of the robot body and feet as shown in Figure 3); 
f(t): functions describing ZMP trajectory. Specifically, the functions represent, as mentioned above, the positions (x, 
y, z) of the ZMP at time t. 

so [0063] The gait functions are described by symbols in view of the parameters. To be more specific, g(t) and f(t) are 
functions which are defined by the gait parameters. Although it is preferable that all the parameters are represented, so 
as to clearly indicate gaits, since the number of parameters is large, only those parameters necessary for the following 
explanation are described here. 

35 g(t: a, b, c, d, x(k), y(k)): functions describing robot motion trajectories; 

f(t: a, b, c, d): functions describing the ZMP trajectory (functions describing the floor reaction force). 

where: 

40 a: initial free leg foot orientation (indicative of the turning angle of the robot) 

b: initial free leg foot positions in the to-and-fro direction (walking stride) 

c: the X-coordinate of ZMP in the single-leg supporting phase 

d: the Y-coordinate of ZMP in the single-leg supporting phase 

x(k): the X-coordinate of body positions in time-series 
45 y(k) : the Y-coordinate of body positions in time-series. 

[0064] in the representation, the time-series data is treated as a kind of parameter. Inherently, without a time-series 
table describing the body position, the gait is solely or deterministically determined when the parameters of the initial 
body position and velocity are given. The body position time-series data is thus redundant. However, in order to shorten 
so the gait generation time on a real-time basis, the body position time-series data table is treated here as a kind of param- 
eter describing gaits. 

[0065] In this embodiment, the initial body position and velocity parameters are different for different gaits. Since, 
however, the initial body position and velocity can be calculated when the body position time-series data are described 
explicitly, no further explanation is made here. 
55 [0066] In the embodiment, the standard gaits such as that for beginning walking from standing position are pre- 
pared using an offline computer as mentioned above. The following three gaits are examples. 

standard gait No. 0 
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g(t: aO, bO, cO, dO, xO(k), yO(k)) 
f(t: aO, bO, cO, dO) 

standard gait No. 1 

5 

g(t: a1, bO, d, d1, x1(k), y1(k)) 
f(t: a1, bO, c1,d1) 

standard gait No. 2 

w 

g(t: aO, b2, c2, d2, x2(k), y2(k)) 
f(t: aO, b2, c2, d2) 



15 



20 



[0067] Figures 5 to 1 1 illustrate the initial free leg foot positions and orientations, and the final free leg foot positions 
and orientations, etc. In order to describe the gaits, the coordinate system is set with a reference point on the supporting 
leg foot sole floor-contact surface as the origin, and the to-and-fro direction of the supporting leg foot as the X-direction 
and the left-to-right direction as the Y-direction. 

[0068] Before entering into the explanation of the flow chart of Figure 4, assume that the demand for gait is given 
as shown in Figures 12 and 13 and taking as an example the generation of the demanded gait (the aforesaid approxi- 
mated gait, referred to hereinafter as "3rd gait") for satisfying the demand using the standard gaits, the operation of the 
system is explained. The demanded gait should have been given initial free leg orientation a3 and to-and-fro position 

b3. 

[0069] Apparently, the parameter a. is a3 and b is b3 in the 3rd gait. The problem is how to determine the other 
parameters c, d and the tabulated values x(k), y(k) so as to satisfy the demand. 
25 [0070] The 3rd gait is therefore described as follows; 

g(t: a3, b3, c3, d3, x3(k), y3(k)) 
f(t: a3, b3, c3, d3). 
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[0071 ] Then the parameters c3, d3 and the time-series tabulated data x3(k) and y3(k) are determined 
[0072] Here, the terms are defined. The parameters a, b include values input as a request (same as the aforesaid 
demand for gait) from outside of the system (such as by an operator via the joystick 62) or through another system (such 
as from the double-leg compliance controller in the block diagram of Figure 3). The parameter whose value is 
demanded directly to be a determined value is called "directly-determined parameter". 

[0073] In order to simplify the explanation, it is described in this embodiment that only the initial free leg foot orien- 
tation and to-and-fro position (stride) can be changed at discretion. Moreover, the following 1) and 2) can be input as 
the demand for gait, as mentioned above. In addition, 3) can also be input which will be mentioned in the fourth embod- 
iment of the present invention. 



40 1 ) instructions from an operator (e.g., instructions on turning angle or turning angular velocity, or locomotion speed) 

2) demand from other system such as a path guidance system, if any (e.g., final free leg foot position and orienta- 
tion) 

3) boundary conditions of gaits between the current gait and the preceding or next gait (e.g., initial body position 
and orientation, initial free leg foot position and orientation). 

[0074] On the other hand, parameters such as c, d, or the tabulated data x(k), y(k) are called dependent parame- 
ters (or tabulated data), which are determined based on the directly-determined parameter such that they satisfy the 
gait conditions. Since it is quite difficult to directly determine the time-series tabulated data, the time-series tabulated 
data is rarely a directly-determined parameter. 

[0075] The aforesaid standard gaits No. 1 or No. 2 (other than the standard gait No. 0) are based on the standard 
gait No. 0 and only one of the directly-determined parameters, (i.e, a or b) differs from that of standard gait No 0) The 
basic gait among the selected standard gaits, (i.e., standard gait No. 0) is called the base gait 

[0076] The determination of the demanded gait parameters (the demanded gait parameters are referred to some- 
times as "mixed parameters" in this specification) will be explained. The dependent parameters c3, d3 and the depend- 
ent tabulated data x3(k), y3(k) vary in response to the directly-determined parameters a, b so as to satisfy the 
conditions of gait. Moreover, it is supposed that they vary continuously in response to the change in the parameters a 
b. The values are therefore continuous functions of the parameters a, b. This means that the following principle of 
approximation can be utilized or applied. In other words, the demanded gait parameters can be calculated by approxi- 
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mation method. 

[0077] To be more specific, if function p is a continuous function, it can be approximated using the following expres- 
sion 

P(a0+Aa, bO+Ab) = P(a0, b0) + &P/&a| (a = aO, b = bO) * Aa+ 6P/5b| (a = aO, b = bO) * Ab 
Approximation 1 

here, 

5P/6a| (a=a0,b=b0) is a partial differential of P relative to a at a = aO , b = bO ; 
5P/5b| (a=aO,b=bO) is a partial differential of P relative to b at a=:aO , b=b0 . 
[0078] Moreover, since 

5P/5a| (a - aO, b = bO) = (P(aO + Aa1 , bO) - P (aO. bO))/Aa1 
5P/ 6b| (a = aO, b = bO) = (P(aO, bO +Ab2) - P (aO, bO))/Ab2 
[0079] Approximation 1 can be rewritten as follows. 

P(aO + Aa, bO + Ab) = P(aO, bO) + {P(aO + Aal, bO) - P(aO, bO)}/AaI * Aa + {P(a0, bO + Ab2) - P(aO. bO))/Ab2 * Ab 
Approximation 2. 

[0080] The first embodiment is a development of Approximation 2 and the second embodiment (explained later) is 
a development of Approximation 1 . 

[0081 ] Continuing the explanation of the demanded gait parameters, the 3rd gait parameters are calculated from 
the standard gaits by dividing internally or externally (i.e., interpolating) all the dependent parameters and time-series 
tabulated data using the following equations. This is because it can be considered that the dependent parameters are 
in proportion to the directly-determined parameters. 

[0082] If a3 is between aland a2, it is calculated by internal division, and if a3 is not between a1 and a2, it is 
obtained by external division. When the difference in the parameter can be neglected in the sense of dynamics the 
parameter may be the same as that in the base gait. If the time-series tabulated data is calculated in the first calculator 
80 at one time, the load of calculation becomes great. Thus, the internal or external division should accordingly be con- 
ducted only for data in the current control cycle. ... , , 
[0083] The followings are the aforesaid equations for mixing (referred to later as "Eqs. 1 ") using internal or external 

division. 

c3 = cO + (d - cO) * (a3 - a0)/(a1 -aO) + (c2 - cO) * (b3 - b0)/(b2 - bO) 

d3 = dO + (d1 - dO) * (a3 - a0)/(a1 -aO) + (d2 - dO) * (b3 - b0)/(b2 - bO) 

x3(k) = xO(k) + (x1(k) - xO(k)) * (a3 - a0)/(a1 - aO) + (x2(k) - x0(k)) * (b3 - bO)/ (b2 - bO) 

y3(k) = yO(k) + (y1(k) - yO(k)) * (a3 - a0)/(a1 - aO) + (y2(k) - yO(k)) * (b3 - bO)/ (b2 - bO) 

[0084] These Eqs. 1 are weighted average calculations of the standard parameters and tabulated data. For exam- 
ple, the equation for obtaining c3 can be rewritten as follows. 

c3={1-(a3-a0)/(a1 - aO) - (b3-b0)/(b2-b0)} *c0 + (a3-a0)/(a1-a0)*cl + (b3 - b0)/(b2 - bO) * c2. 

[0085] Since the sum of the weighted coefficients of cO, d , c2 is 1 , c3 is a weighted average whose weights of cO, 
d and c2 are respectively; 

{1 - (a3 - aO)/ (al - aO) - (b3 - bO)/(b2 - bO)} 
(a3 - aO)/(al -aO) 
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(b3 - b0)/(b2 - bO). 

[0086] If the final body position and orientation should be varied at discretion as a directly-determined parameter, 
it suffices if a weighted average of the base gait and some standard gait whose ZMP parameters are different from each 
other is calculated. Since the final state of the mixed gait is nearly equal to the weighted average of the final states of 
the standard gaits including the base gait to be mixed, it suffices if the weights of the weighted average are determined 
such that the final state of the mixed gait (including the to-and fro position and velocity of the body) are identical to the 
demanded value. 

[0087] If the body position is determined from the time-series tabulated data, the mixed gait will entirely satisfy the 
demanded value with respect to the final state conditions. However, when the body position is determined sequentially 
by dynamics calculation such that the determined ZMP trajectory is satisfied, as will be described in the seventh 
embodiment, it deviates to a small extent 

[0088] In determining the weights, each final state of the standard gaits to be mixed should be known. If the final 
states of the standard gaits have been prepared as tabulated data and stored in memory, it becomes possible to reduce 
the calculation time. 

[0089] In the manner explained above, the mixed gait parameters are determined, and instantaneous values of the 
demanded gait at each time are generated or determined in the same way as the gait generation algorithm of the stand- 
ard gait prepared by an offline computer. 

[0090] Based on the above, the operation of the system according to the invention will be explained with reference 
to a flow chart shown in Figure 4. The program begins at S10 in which the standard gait data prepared by an external 
computer have been loaded to or stored in the ROM 84. The program proceeds to S12 in which final body positions and 
velocities in each standard gait are calculated and stored in the memory. 

[0091 ] Since the body position has been prepared as a function x(k), y(k) as mentioned above, the body velocity 
should be calculated from the final value and the value preceding the final value in the tabulated data. More specifically, 
the final value in the tabulated data is immediately determined as the position, and the difference between this value 
and the value preceding the final value is calculated and is used to determine the velocity. 

[0092] The program then proceeds to S14 in which the timer value t is reset to zero (in other words, the timer is 
started), to SI 8, via S16, in which a timer interrupt is waited for (the timer is different from that in Si 4). The procedures 
shown in the flow chart of Figure 4 are executed once per predetermined period such as 20 msec, i.e., the control cycle 
is 20 msec. 

[0093] The program then proceeds to S20 in which it is determined whether the gait is at the time of, switching (the 
end of a single walking step), or more specifically whether it is the time for switching the waking step. When the result 
is affirmative, the program proceeds to S22 in which the timer is reset to zero, to S24 in which the demanded value for 
gait, specifically the demanded value of the directly-determined parameters at the current gait (the new gait which 
begins from this time), i.e. the aforesaid a and b are read. 

[0094] The program then proceeds to S26 in which procedures for gait mixing are conducted. 
[0095] Figure 14 is a flow chart showing the subroutine of the gait mixing procedures. 

[0096] The program begins at S100 in which one standard gait whose directly-determined parameters are close to 
the demanded value is selected as the base gait. Explaining this with reference to Figure 15, since the standard gait 
whose directly-determined parameters a, h are close to the demanded value (3rd gait's) a3, b3, is standard gait No. 0, 
the standard gait No. 0 is selected as the base gait. 

[0097] The program then proceeds to S102 in which, noticing the above-mentioned directly-determined parame- 
ters, standard gaits are separately selected which are different in one of the directly-determined parameters from that 
of the base gait. When there are plural candidates, the standard gait whose parameter is as close as possible to the 
noticed parameter should be selected. It is preferable to select the standard gait whose parameter sandwiches the 
demanded value with the base gait parameters. Specifically, when the situation is as shown in Figure 16, standard gait 
No. 1 should preferably be selected with respect to the parameter a. 

[0098] As will be explained in the fifth embodiment, when the mass of leg links 2 is sufficiently smaller than that of 
the body 24, the inertial force generated by the robot 1 will change little if the final free leg foot position and orientation 
in the directly-determined parameters vary slightly. In other words, the change of the parameters would not influence 
the other parameters in satisfying the dynamic equilibrium condition. 

[0099] Accordingly, if the final free leg foot position and orientation parameters differ slightly from those of the base 
gait, this can easily be solved by changing the base gait parameter values as demanded. By doing so it becomes 
unnecessary to select standard gaits to be mixed, whose final free leg foot position and orientation parameters are only 
different from those of the base gait. 

[0100] The program then proceeds to Si 04 in which the demanded values are substituted for the directly-deter- 
mined parameters of the mixed gait, to S106 in which the dependent parameters of the mixed gait are calculated using 
the equations for parameter calculation (Eqs. 1). 



11 



1018467A1 I > 



EP 1 01 8 467 A1 



[0101] Returning to the explanation of Figure 4, the program then proceeds to S28 in which the mixed gait param- 
eters (tabulated values) are substituted for the desired gait parameters (tabulated data), to S30 in which the instanta- 
neous values (i.e. , the values at the current control cycle) of the desired gait are calculated. 
[0102] Figure 1 7 is a flow chart showing the subroutine of the procedures. 
5 [0103] Explaining this, the program starts at S200 in which the ZMP at time t is determined or calculated based on 
the mixed gait parameters, to S202 in which the feet position and orientation are determined or calculated based on the 
mixed gait parameters using the aforesaid technique proposed earlier. 

[0104] The program proceeds to S204 in which the body height at time t is determined or calculated from the feet 
position and orientation at time t and the horizontal body position at time t - At. Since the details of this are described in 
10 another patent application filed at the same time as the present invention as mentioned above, and have no direct rela- 
tionship with the gist of the present invention, explanation is omitted. 

[01 05] The program proceeds to S206 in which the horizontal body position of the mixed gait at time t is calculated 
based on the body position at time t of the selected standard gaits (including the base gait) in accordance with the afore- 
said equations for mixing (Eqs. 1). 
15 [0106] Returning to the explanation of Figure 4, the program proceeds to S32 in which time t is updated by At and 
returns to S18 to repeat the procedures mentioned above. 

[01 07] Based on the gait thus generated, the double-leg compliance control is conducted, if necessary, by the dou- 
ble-leg compliance controller and the desired joint angles are determined. The joints are then controlled to trace the 
desired joint angles. 

20 [01 08] The double-leg compliance control will be explained briefly with the reference to the flow chart of Figure 1 8. 
[0109] In the flow chart, the program starts at S300 in which a manipulated variable of the double-leg compliance 
control is calculated. 

[0110] Figure 19 is a flow chart showing the subroutine of the procedures. Explaining the flow chart, the program 
begins at S400 in which the output from the 6-axis force and torque sensor 44 is read, and proceeds to S402 in which 

25 the actual position of the ZMP (the actual floor reaction force central point) is determined, to S404 in which the deter- 
mined value is compared with the desired ZMP position and the difference therebetween, i.e., the direction of difference 
and the amount of difference X are determined, to S406 in which the manipulated variable of the feet is determined in 
accordance with the equation illustrated there, to S408 in which the feet position and orientation are deviated or shifted 
by the determined manipulated variable. The actual ZMP position and the actual floor reaction force central point are 

30 equal to each other, hence they are treated as the same in this specif ication. 

[01 1 1 ] Returning to the explanation of the flow chart of Figure 1 8, the program proceeds to S302 in which desired 
angles of the 1 2 joints are calculated by a known inverse kinematic solution based on the feet positions and orientations 
(corrected feet positions and orientations if corrected in the compliance controller) and the body position and orienta- 
tion. The program proceeds to S304 in which the desired posture is corrected so as to intentionally deviate or shift the 

35 floor reaction force central point, when the robot 1 is determined to be unstable from the output of the inclination sensor 
44. The program proceeds to S306 in which all joints are driven to trace the desired joint angles. Specifically, this is con- 
ducted by the second calculator 82. 

[0112] Having been configured in the foregoing manner, the system in the first embodiment can generate a gait 
freely on a real-time basis and can effect a desired stride or turn in a desired angle. Moreover, the system can make the 

40 legged mobile robot walk freely by driving the joint angles based on the gait generated on a real-time basis. 

[0113] More specifically, the system can freely generate an approximate gait on a real-time basis which satisfies 
the aforesaid conditions of gait or the demand for gait by appropriately selecting some of gait as the base gait from 
among the stored standard gaits in response to the demand on the stride or turning angle, and by mixing (such as syn- 
thesizing, modification, etc.), i.e., by conducting approximation. 

45 [0114] Moreover, with the arrangement, the system can freely generate a gait having an accurate stride or turning 
angle, and by combining and mixing the standard gaits, can generate at discretion an average gait therebetween. 
[0115] Furthermore, the system can reduce the amount or volume of calculation. More particularly speaking, the 
amount of calculation on the first calculator 80 will be reduced by 90%, compared with a case in which the robot dynam- 
ics problem is solved on a real-time basis. Moreover, as the appropriate standard gaits are stored in advance and a gait 

so is newly generated by mixing the standard gaits together, it becomes possible to reduce the amount or capacity of mem- 
ory (the ROM 84). Furthermore, as the standard gaits can be prepared optimally, it becomes possible to generate eas- 
ily, without trial and error, a new gait which satisfies the conditions 1) to 5) mentioned above. 

[0116] Figure 20 is a flow chart showing the operation of the system according to the second embodiment of the 
present invention. 

55 [0117] In the second embodiment in addition to the standard gaits, a sensitivity of a gait parameter is used. The 
"sensitivity" generally means the ratio of the response or change induced in the output to a stimulus or change in the 
input. In the second embodiment, an amount of change in one gait parameter per unit amount of change in the other 
gait parameter is determined or calculated. The amount of change in one gait parameter is referred to as "gait param- 
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eter sensitivity" and is used to determine the amount of change (or variation) of a parameter. 

[0118] Described simply, gait parameter sensitivity refers to how much the dependent parameters should be 
changed or varied in order that the changed gait keeps desirable conditions if and when the directly-determined param- 
eters (such as the initial free leg foot orientation a, the initial free leg foot to-and-for position b in the first embodiment) 
are changed by a small amount. Thus, the gait parameter sensitivity is defined as the amount of dependent parameter 
change per unit amount of the directly-determined parameters. 

[0119] In the second embodiment, as a result, the number of standard gaits are reduced and only those suitable for 
the base gait are used. More specifically, the standard gaits comprising a series of continuous gaits having a gait to start 
walking from a standing position, a gait for accelerating the walking speed, a gait for constant speed walking, a gait for 
decelerating the walking speed, and a gait to stop walking, are similarly used. However, no other standard gaits whose 
parameters are slightly different from those of the series of successive gaits are prepared. 

[01 20] To be more specific, the sensitivity of a parameter g relative to a parameter a in a standard gait i is described 
as Di (q,p). In the tabulated data, the sensitivity of k-th datum x(k) relative to the parameter p_ is similarly described as 
Di(x(k),p). 

[01 21 ] The generation of the demanded gait in the second embodiment will be explained. 

[0122] The relationships between the parameter c's sensitivity relative to the parameter a in standard gait No.O 
(referred to as D0(c, a)) and those in standard gait No. 1 will be shown as follows in accordance with the definitions 
when (a1 - aO) is sufficiently small. 



DO (c, a)=(d - c0)/(a1 - aO) 

DO (d, a) = (d1 - d0)/(a1 -aO) 

DO (x(k), a) = (x1(k) - x0(k)) /(a1 - aO) 

DO (y(k), a) = (y1(k) - y0(k)) /(a1 - aO) 

[0123] Similarly, the relationships between the parameter c's sensitivity relative to the parameter b in standard gait 
No. 0 (referred to as D0(c,b)) and those in standard gait No. 2 will be shown as follows in accordance with the defini- 
tions, when (b2 - bO) is sufficiently small. 



DO (c, b) = (c2 - cO) /(b2 - bO) 

DO (d, b) = (d2 - d0)/(b1 - bO) 

DO (x(k), b) = (x2(k) - xO(k)) /(b2 - bO) 

DO (y(k), b) = (y2(k) - y0(k)) /(b2 - bO) 

[01 24] The following will be obtained as equations for parameter determination (hereinafter referred to as "Eqs 2") 
by substituting these in the equations for mixing the parameters and tabulated data in the first embodiment. 

c3 = cO + D0(c, a) * (a3 - aO) + DO (c, b) *(b3 - bO) 

d3 = dO + D0(d, a) * (a3 - aO) + DO (d, b) *(b3 - bO) 

x3(k) =x0(k) + D0(x(k), a) *(a3 - aO) + D0(x(k), b) * (b3 - bO) 

y3(k) = yO(k) + D0(y(k), a) *(a3 - aO) + D0(y(k), b) * (b3 - bO) 

[0125] Based on the above, the operation of the second embodiment will be explained with reference to Figure 20. 
The program begins at S500 in which the base gaits and gait parameter sensitivities prepared by an offline computer 
have been stored in memory and then proceeds to S502 and to S514 to conduct the same procedures as those of the 
first embodiment, then to S516 in which the procedures for gait mixing are conducted. 

[01 26] Figure 21 is a flow chart for showing the subroutine of the procedures. The program begins at S600 in which 
the base gait whose directly-determined parameters are close to the demanded values is selected, and proceeds to 
S602 in which the demanded values are substituted for the directly-determined parameters of the mixed gait, to S604 
in which the dependent parameters are calculated in accordance with Eqs. 2. The tabulated data of the horizontal body 
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position may be calculated at one time. However, since the volume of calculation thereof is great, each value necessary 
for the current control cycle may be calculated in the subroutine of the instantaneous value calculation explained later. 
[0127] Returning to the explanation of Figure 20, the program proceeds to S520, via S518, in which the instanta- 
neous values of the desired gait are calculated. 

[0128] Figure 22 is a flow chart showing the subroutine of the procedures. The program begins at S700 and then 
proceeds to S702 and to S706 in which the positions and orientations of the feet and body are calculated. In S706, the 
horizontal body position is calculated in accordance with the equations relating to x, y in Eqs. 2. Returning to the expla- 
nation of Figure 20, the program returns, via S522, to S508 to repeat the procedures. 

[0129] Having been configured in the foregoing manner, the system in the second embodiment has the same 
advantages as those of the first embodiment. 

[01 30] However, the superiority of the second embodiment over the first embodiment depends on the combination 
of the standard gaits or the nature or characters of the standard gaits being stored in memory. For example, naming all 
space generated by the combinations of the directly-determined parameters as a parameter space, the first embodi- 
ment may be configured such that the directly-determined parameters are discretized for a certain interval in such a 
manner that lattice-like discrete spaces are prepared in the parameter space, and desired standard gaits are prepared 
for all the combination of the directly-determined parameters in the discrete spaces. To be more specific, the first 
embodiment may be configured such that the parameters other than the directly-determined parameters, i.e., the 
dependent parameters, are adjusted so that the gaits become desirable gaits. 

[0131] If the first embodiment is provided with the standard gaits prepared in the above-mentioned manner, most 
of standard gaits can satisfy the condition to be the base gait. (The standard gait whose directly-determined parameters 
are entirely same as those of the other existing standard gait, except for any one parameter, can satisfy the conditions 
as the base gait.) If the first embodiment is modified as above, no parameter sensitivity is needed for generating gaits 
freely. 

[01 32] It should be noted in the second embodiment that, when the parameter sensitivities are almost equal for var- 
ious gaits, the parameter sensitivities need not be prepared for each gait, but one may be prepared that is common for 
all the gaits. With the arrangement, the capacity of the memory (the ROM 84) can be reduced to a great extent com- 
pared to that in the first embodiment. 

[0133] For example, if D0(c, a), D1(c, a), D2(c, a)...Dn(c, a) are almost the same, the average value D(c, a) thereof 
can instead be used in all the equations for parameter determination. 

[0134] Figure 23 is a flow chart showing the operation of the system according to the third embodiment of the 
present invention. 

[01 35] In the third embodiment, both the standard gaits used in the first embodiment and the parameter sensitivities 
in the second embodiment are used. 

[0136] The generation of a demanded gait in the third embodiment is now explained. 

[0137] In the third embodiment, when calculating the dependent parameter values, the influence of the directly- 
determined parameters are determined partially by using the method of the first embodiment, while the rest of the influ- 
ence is determined using the method of the second embodiment. More precisely, gait mixing as well as an addition of 
perturbation due to the gait parameter sensitivity are used. 

[0138] To be more specific, if using the first embodiment for the influence of the directly-determined parameter a 
and the second embodiment for that of the parameter b, the equations for parameter determination will be rewritten as 
follows. 

c3 = cO + (d - cO) * (a3 - aO) /(a1 - aO) + DO (c. b) *(b3 - bO) 

d3 = dO + (d1-d0) * (a3-a0)/(a3-a) + DO (d,b) * (b3-b0) 

x3(k) = x0(k) + (x1(k) - x0(k)) * (a3 - a0)/(a1 - aO) + DO (x(k), b) * (b3 - bO) 

y3(k) = y0(k) + (y1(k) - y0(k)) * (a3 - a0)/(a1 - aO) + D0(y(k), b) * (b3 - bO) 

[0139] Explaining the operation with reference to Figure 23, the program begins at S800 in which the standard gaits 
and gait parameter sensitivities prepared by an offline computer and stored in memory are read, and proceeds to S802 
and on in which the same procedures as the first embodiment are taken, to S900 and onward, via S816, as described 
in a flow chart of Figure 24 in which the gait mixing is conducted. Then, the program proceeds from S820 in the flow 
chart of Figure 23 to S1000 and onward in a flow chart of Figure 25 in which the instantaneous values are calculated. 
[0140] Having been configured in the foregoing manner, the system in the third embodiment has the same advan- 
tages of the foregoing embodiments. 

[0141] Figure 26 is a flow chart showing the operation of the system according to the fourth embodiment of the 
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present invention. 

[0142] As illustrated in Figure 27, the body positions and orientation in the mixed gaits (demanded gait) obtained 
from the standard gaits tend to be slightly discontinuous with each other at the gait boundary. The final body position 
and velocity of one mixed gait should therefore be accorded with the initial body position and velocity of the next mixed 

5 gait. In view of this, the fourth embodiment is configured such that the boundary conditions of the body position and ori- 
entation can freely be determined. In other words, the initial and final body positions and velocities are deemed as the 
directly-determined parameters, enabling the body position and velocity to be continuous at the gait boundary. 
[0143] Summarizing this method, the mixed gait is first generated in which all the directly-determined parameters 
(except for those of the initial and final body positions and velocities) are as desired, using any method from the first to 

w third embodiments. Then, the ZMP parameters are corrected in order that the initial and final body positions and veloc- 
ities are as desired. 

[0144] Since the former of these procedures are the same as those of foregoing embodiments, explanation is omit- 
ted. The explanation will only be made on the latter of these procedures for correcting the ZMP parameters such that 
the initial and final body positions and velocities become as desired. 

75 [0145] In the gait generation described in the foregoing embodiments, assume that the gait parameters (except for 
the initial body position and velocity, the final body position and velocity and the ZMP parameters) are fixed. 
[0146] Under the assumption, when the initial body position and velocity and the ZMP parameters are determined, 
a gait satisfying the dynamic equilibrium condition is deterministically obtained. As a result, the final body position and 
velocity are deterministically obtained. On the other hand, giving the final body position and velocity and the ZMP pat- 

20 tern will deterministically yield the initial body position and velocity. This means that, in order to freely determine the ini- 
tial body position and velocity and the final body position and velocity, the ZMP pattern should be adjusted in response 
thereto. Saying this in reverse, if the ZMP pattern has once been determined, the relationship between the combination 
of the initial body position and velocity and the combination of the final body position and velocity is one-to-one map- 
ping. 

25 [0147] In order to simplify the explanation, only the behavior of the body to-and-fro direction (i.e., the X-direction) 
will be discussed. Since the quantities of state are two parameters, i.e., the position and velocity, the ZMP pattern 
should have two or more parameters in order that the gait conditions thereof can freely be determined. 
[0148] Here, the ZMP patterns and its parameters are defined as shown in Figure 28 such that the boundary body 
position and velocity can be changed greatly if the ZMP parameters are changed by a small amount. 

30 [0149] The ZMP pattern illustrated in the figure is more complicated than those in the foregoing embodiments. The 
reason is that, if a similar ZMP pattern to any in the foregoing embodiments is used, in addition to the parameter c, 
another parameter in time t2 (which does not influence the foot trajectory) must also be varied. However, even if the 
parameter in time t2 is varied greatly, the boundary body position and velocity will only be corrected by a small amount. 
[0150] In the fourth embodiment, the ZMP parameter can be determined using any method in the first or second 

35 embodiments. In the fourth embodiment, accordingly, using the third embodiment method, a correction amount for the 
ZMP parameters and corrected body trajectories are determined in the manner explained below. The correction amount 
for the ZMP parameters is a correction amount to be added to the mixed gait ZMP parameter in order that the boundary 
body conditions of the mixed gait become desired values. 

[0151] Explaining the operation of the system according to the fourth embodiment with reference to Figure 26, the 
40 program begins at S1 100 in which the standard gaits prepared on an offline computer have been stored in memory sim- 
ilarly to the foregoing embodiments, and proceeds to Si 102 in which the final body positions and velocities of the vari- 
ous standard gaits are determined and stored in memory, to S1 104 in which the following procedures are taken. 
[0152] Specifically, as illustrated in Figure 29. the ZMP parameter c in the mixed gait is slightly perturbed by an 
amount Ac and in response thereto, a perturbation amount A x(k) of the body position time-series tabulated data to be 
45 perturbed is calculated so as to satisfy the dynamic equilibrium condition. The relationship between these quantities is 
defined as follows. 

Rmix (x(k), c) = Ax(k)/Ac 

so [0153] Here, Rmix(x(k), c) (which corresponds to the aforesaid gait parameter sensitivity) is called a partial differ- 
ential sensitivity of x(k) relative to c. Similarly, as illustrated in Figure 30, Rmix (x(k), e) is determined relative to the ZMP 
parameter e. 

[01 54] In the second embodiment, when determining the sensitivity of x(k) relative to a certain parameter noticed, 
dependent parameters other than x(k) or the noticed parameter are adjusted for, while keeping the optimum of the gait 
55 as the conditions of constraint. On the contrary, in the fourth embodiment, all the parameters (other than the noticed 
parameter and x(k)) are made fixed and the sensitivities are determined, while ignoring the optimum of the gait. Figu- 
ratively speaking, the second embodiment determines total differential values deeming the gait optimum as the condi- 
tions of constraint, whereas the fourth embodiment determines partial differential values without paying attention to the 
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gait optimum. 

[0155] Returning to the explanation of Figure 26, the program proceeds to S1 106 in which based on thefinal values 
and on the values immediately preceding thereto of Rmix(x(k), c) and Rmix (x(k), e), a partial differential sensitivity 
Rmix (Xe, c) of the final body position and a partial differential sensitivity Rmix (Ve, c) relative to the mixed gait ZMP 
5 parameter c, a partial differential sensitivity Rmix (Xe, e) of final body position and a partial differential sensitivity Rmix 
(Ve, e) relative to the mixed gait ZMP parameter e are calculated as follows. 

Rmix (Xe, c) = Rmix (x(ke), c) 

to Rmix (Ve, c) = (Rmix(x(ke), c) - Rmix(x(ke-1), c)}/At 

Rmix (Xe, e) = Rmix (x(ke), e) 

Rmix (Ve, e) = {Rmix(x(ke). e) ■ Rmix(x(ke-1). e)}/At 

Here, ke: final number of tabulated data, At: sampling time, more precisely sampling interval in discrete-time series of 
tabulated data. 

[0156] The program proceeds to S 11 08 in which a matrix of dimension 2*2 having Rmix(Xe, c) as the element of 
the 1st row 1st column, Rmix(Xe, e) as the element of the 1st row 2nd column, Rmix(Ve, c) as the element of the 2nd 

20 row 1st column, Rmix(Ve, e) as the element of the 2nd row 2nd column, is generated. 

[01 57] The program proceeds to S1 1 1 0 in which the inverse matrix of the matrix just generated is calculated. In the 
inverse matrix, the element of the 1st row 1st column is a partial differential sensitivity of the parameter q relative to the 
final body position Xe (referred to as Rmix(c, Xe)), the element of the 2nd row 1st column is a partial differential sensi- 
tivity of the parameter e relative to the final body position Xe (referred to as Rmix(e, Xe)), the element of the 1 st row 2nd 

25 column is a partial differential sensitivity of the parameter c relative to the final body velocity Ve (referred to as Rmix(e, 
Xe)), and the element of the 2nd row 2nd column is a partial differential sensitivity of the parameter e relative to thefinal 
body velocity Ve (referred to as Rmix (e, Ve)). 

[0158] If these sensitivities change little in all of the mixed gaits, the average values thereof R(c, Xe), R(e, Xe), R(c, 
Ve), R(e, Ve) may instead be used for all the gaits. 
so [01 59] The program proceeds to S1 1 1 2 in which the initial body position in the mixed gait is shifted or perturbed by 
a small amount AxO as illustrated in Figure 31 , and a body position time-series tabulated data perturbation amount A 
x(k) is determined in response thereto so as to satisfy the dynamic equilibrium condition. The value is obviously as fol- 
lows. 

35 Ax(0)=AxO 
[0160] Rmix (x(k), xO) is determined as follows. 

Rmix(x(k), xO) =A x(k)/Ax0 

4C 

[0161] Similarly, the initial body velocity is shifted or perturbed by a small amount AvO, as illustrated in Figure 32 
and Rmix(x(k), vO) is determined in a similar manner. 

[0162] The program then proceeds to S1 1 1 4 in which based on the final values and on the values immediately pre- 
ceding thereto of the determined sensitivities Rmix(x(k), xO) and Rmix (x(k), vO), a partial differential sensitivity of the 
45 final body position and a partial differential sensitivity relative to the initial body position in the mixed gait (referred to as 
Rmix (Xe, xO) and Rmix (Ve, xO)), a partial differential sensitivity of final body position and a partial differential sensitivity 
relative to the initial body velocity in the mixed gait (referred to as Rmix (Xe, vO) and Rmix (Ve, vO)) are calculated as 
follows. 

so Rmix (Xe, xO) = Rmix (x(ke), xO) 

Rmix (Ve, xO) = (Rmix(x(ke), xO) - Rmix(x(ke-1), x0)}/At 
Rmix (Xe, vO) = Rmix (x(ke), vO) 

55 

Rmix (Ve, vO) = {Rmix(x(ke), vO) - Rmix(x(ke-1), v0)}/At 
Here, ke: final number of tabulated data, At: sampling time of tabulated data. 



16 



BNSDCCfD: <EP .. . . 1 01 8467A 1 _|_ > 



EP1 018 467 A1 



[0163] The program then proceeds to S1 1 16 in which the timer is reset to zero and is started, to S1 120, via S1 1 18, 
in which the timer interrupt is waited for, to S1 122 in which it is determined whether the gait is to be switched. When the 
result is affirmative, the program proceeds to S1 124 in which the timer is reset to zero, to S1 126 in which the demanded 
values of the directly-determined parameters are read, then to S1 128 in which the gait mixing is conducted. 
t [01 64] Specifically, the program proceeds to S1 200 of the subroutine flow chart of Figure 33 in which the mixed gait 
parameters are generated using any method in the first to third embodiments. In this mixed gait parameter generation, 
one from among gaits the whose initial and final body positions and velocities are close to the demanded values, is 
selected as the base gait. 

[01 65] However, once selected as the base gait, the initial and final body positions and velocities are excluded from 
10 the directly-determined parameters, and the mixed gait is generated in the same manner as the foregoing embodi- 
ments. 

[0166] The program then proceeds to S1202 in which the differences between the demanded initial body position 
and velocity and the mixed gait initial body position and velocity are calculated. The differences are named AxO, AvO. 
Similarly, the differences between the demanded final body position and velocity and the mixed gait final body position 
75 and velocity are calculated, and are named AXe, AVe. 

[0167] The program proceeds to S1204 in which only the initial body position and velocity in the mixed gate are 
replaced with the demanded initial body position and velocity. Then final body position and velocity perturbation 
amounts of the gait when the body position time-series tabulated data are perturbed in response thereto such that the 
dynamic equilibrium condition is satisfied (referred to as AXse, AVse), are calculated by the following equations. 

20 

AXse = Rmix (Xe, xO) * AxO + Rmix (Xe, vO) * AvO 

AVse = Rmix (Ve, xO) * AxO + Rmix (Ve, vO) * AvO 

25 [0168] In the gait obtained in S1204, the initial body position and velocity accord with the demanded values. How- 
ever, the final body positions and velocity are not equal to the demanded final body position and velocity, and differ by 
AXe+AXse and AVe+A Vse. The program therefore proceeds to S1206 in which ZMP parameter correction amounts Ac 
and Ae for decreasing the differences to zero, are calculated by the following equations. 

30 Ac = Rmix(c, Xe) * (AXe+AXse) + Rmix(c, Ve) * (AVe+AVse) 

Ae = Rmix(e, Xe) * (AXe+AXse) + Rmix(e, Ve) * (AVe+AVse) 

[0169] The program then proceeds to S1208 in which the ZMP parameters c, e are calculated using the following 
35 equations. 

c = cmix + Ac 
e = emix + Ae 

40 

Here, cmix: value of mixed gait parameter c; emix: value of mixed gait parameter e. 

[01 70] Returning to the explanation of the flow chart of Figure 26. the program then proceeds to S1 1 30 in which the 
mixed gait parameters are substituted for desired gait parameters. Here, the values obtained in S1208 are substituted 
for the parameters c, e. The program then proceeds to S1132, via S1 122, in which the instantaneous values of the 
45 desired gait are calculated. 

[01 71 ] Specifically the program proceeds to S1 300 in a flow chart of Figure 34 in which the ZMP at time t is deter- 
mined using any method in the foregoing embodiments, to S1 302 in which the feet position and orientation at time t are 
determined using any method in the foregoing embodiments, to Si 304 in which the body position of the desired gait is 
determined using the following equation. 

5C 

x(k) = xmix(k) + Rmix(x(k), c) * Ac + Rmix(x(k), e) * Ae + Rmix (x(k), xO) * AxO + Rmix(x(k), vO) * AvO 

Here, xmix(k): k-th datum in the mixed gait body trajectory time-series tabulated data. Although no explanation is made 
here, the body position in the Y-direction is similarly calculated. The body position in the Z-direction may be calculated 
55 in the same manner as the X, Y-direction values, or may be calculated using the technique described in the application 
filed at the same date as the present invention. 

[0172] In the manner described above, more specifically, by superposing waveforms shown in Figures 27, 29 to 32, 
the desired gait having the boundary conditions as desired can be generated, as illustrated in Figure 35. In Figure 35, 
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the situations are set as follows. 

c<0, c+Ac <0, e <0, e+Ae >0 

[0173] Having been configured in the foregoing manner, the system in the fourth embodiment can generate gaits 
freely on a real-time basis and make the displacements and velocities of robot portions continuous at the boundary of 
the gaits. 

[01 74] Figure 36 is a flow chart showing the operation of the system according to the fifth embodiment of the inven- 
tion. 

[0175] In the fourth embodiment mentioned above, the body position time-series partial differential sensitivity rela- 
tive to the mixed gait ZMP parameter c_ (Rmix(x(k), c)), the body position time-series partial differential sensitivity rela- 
tive to the mixed gait ZMP parameter e (Rmix(x(k), e)), the body position time-series partial differential sensitivity 
relative to the initial body position (Rmix(x(k) t xO), and the body position time-series partial differential sensitivity relative 
to the initial body velocity (Rmix(x(k), vO) are used. So to speak, the fourth embodiment has a model of body trajectory 
perturbation in time-series tabulated data relative to the ZMP perturbation. 

[0176] Rather, the fifth embodiment uses a linear dynamic perturbation model (a linear model expressing the rela- 
tionship of perturbations of the body position and velocity relative to a perturbation of the ZMP) described by the follow- 
ing expression so as to accord the boundary conditions on the body position and velocity with the demanded values. 
[0177] The basic principle of this method will first be explained. Although the body behavior and the ZMP trajectory 
are discussed only in the to-and-fro direction (X-direction), the same will also be applied to the left and right direction 
(Y-direction). 

[0178] Assume that the mass of the body 24 of the robot 1 is sufficiently larger than that of the other portions and 
that the vertical body acceleration is relatively small during walking. If this specific condition is met, the relationship of 
the body position and velocity perturbation relative to the ZMP perturbation, i.e., the dynamic perturbation model can 
be approximated by the following equation, i.e., a linear inverted pendulum model illustrated in Figure 37. As illustrated 
in the figure, the model has a supporting point 22a which is movable. 

dxmdl/dt = v 

dvmdl/dt = co0 2 * (xmdl - ZMPmdl) 

Here, xmdl: the position of the center of mass of the linear inverted pendulum; vmdl: velocity of the center of mass of 
the linear inverted pendulum. co0 is a positive constant which is approximated by the relationship between the height of 
the center of gravity of the body h and the gravitational constant g as follows. 

coO = V(g/h) 

[0179] When the specific condition is met, the linear inverted pendulum model can be used instead of the pertur- 
bation model (which is more general than the above-mentioned model) expressed by Rmix(x(k), c), Rmix(x(k), e), 
Rmix(x(k), xO), Rmix(x(k), vO) used in the fourth embodiment. In the following explanation, if the states of the model 
should preferably be described with time, they will be described as xmdl(t), vmdl(t), etc. 

[0180] Based on the above, the operation will be explained with reference to Figure 36. The configuration of the 
ZMP pattern is the same as that in the fourth embodiment. 

[0181] The program starts at S1400 in which the standard gaits have been stored in memory and proceeds to 
S1402 in which the final body positions and velocities in each of the standard gaits have been calculated and stored in 
memory. The program then proceeds to S1404 in which the behavior of the dynamic perturbation model is calculated 
up to the final time of the gait, and the final model position Xe and the final model velocity Ve are calculated, setting the 
ZMP parameters, as illustrated in Figure 35, c =1 , e = 0, p (ZMP value at time 0) =0, ZMP values at the other braking 
points =0, while setting its initial states as xO = 0 and vO = 0. 

[0182] More specifically, this is done by setting Ac (the ZMP pattern correction amount shown in Figure 29) to 1, 
and inputting, the ZMP patterns as illustrated in Figure 29, to the model to obtain the behavior of the model. Then the 
final states of the model are obtained, and the partial differential sensitivity of the final model position Xe relative to the 
ZMP parameter c (referred to as R(Xe, c)), is calculated as follows. 

R(Xe, c) = Xe 

[0183] Similarly, the partial differential sensitivity of the final model velocity Ve relative to the ZMP parameter c, is 
calculated as follows. 
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R(Ve, c) = Ve 

[0184] The behavior of the dynamic perturbation model can be calculated by discretizing the model and then by 
conducting sequential calculation, or can be solved by analysis. 

[0185] The program then proceeds to S1 406 in which the behavior of the dynamic perturbation model is calculated 
up to the final time of the gait and the final model position Xe and the final model velocity Ve are calculated, setting the 
ZMP parameters c=0, e-1, p=0, ZMP values at the other braking points =0, while setting its initial states as x0=0 and 
v0=0. 

[0186] Then, the partial differential sensitivity of the final model position Xe relative to the ZMP parameter e, is cal- 
culated as follows. 

R(Xe, c) = Xe 

[0187] At the same time, the partial differential sensitivity of the final model velocity Ve relative to the ZMP param- 
eter e, is calculated as follows. 

R(Ve, c) = Ve 

[0188] The program then proceeds to S1 408 in which the behavior of the dynamic perturbation model is calculated 
up to the final time of the gait and the final mode! position Xe and the final model velocity Ve are calculated, setting the 
ZMP parameter c=0, e=0, p=0, ZMP values at the other braking points =0, while setting its initial states as x0=1 and 

v0=0. 

[0189] Then, the partial differential sensitivity of the final model position Xe relative to the initial model position xO, 
is calculated as follows. 

R(Xe, xO) - xe 

[0190] At the same time, the partial differential sensitivity of the final model velocity Ve relative to the initial model 
position xO, is calculated as follows. 

R(Ve, xO) = Ve 

[01 91 ] The program then proceeds to S1 41 0 in which the behavior of the dynamic perturbation model is calculated 
up to the final time of the gait and the final model position Xe and the final model velocity Ve are calculated, setting the 
ZMP parameters c=0, e=0, p =0, ZMP values at the other braking points =0, while setting its initial states as x0=0 and 
v0=1. 

[0192] Then, the partial differential sensitivity of the final model position Xe relative to the initial model velocity vO, 
is calculated as follows. 

R(Xe, vO) = Xe 

[0193] At the same time, the partial differential sensitivity of the final model velocity Ve relative to the initial model 
velocity vO, is calculated as follows. 

R(Ve, v0)=Ve 

[01 94] The program then proceeds to S1 41 1 in which the behavior of the dynamic perturbation model is calculated 
up to the final time of the gait and the final model position Xe and the final model velocity Ve are calculated, setting the 
ZMP parameters c=0, e=0, p=1, ZMP values at the other braking points =0, while setting its initial states as x0=0 and 
v0=0. 

[01 95] Then, the partial differential sensitivity of the final model position Xe relative to the initial ZMP p, is calculated 

as follows. 

R(Xe, p) Xe 

[0196] At the same time, the partial differential sensitivity of the final model velocity Ve relative to the initial ZMP p 
(referred to as R(Ve, p), is calculated as follows. 
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R(Ve, p) = Ve 

[0197] The program then proceeds to SI 41 2 in which based on the sensitivities thus obtained, a 2*2 matrix is gen- 
erated, whose 1st row 1st column element is R(Xe, c), 1st row 2nd column element is R(Xe, e), 2nd row 1st column 

5 element is R(Ve, c), and 2nd row 2nd column element is R(Ve, e). 

[0198] The program then proceeds to S1414 in which the inverse matrix thereof is calculated. In the inverse matrix, 
the element of the 1st row 1st column is the partial differentia! sensitivity of the parameter c relative to the final model 
position Xe (referred to as R(c, Xe)), the element of the 2nd row 1st column is the partial differentia! sensitivity of the 
parameter e relative to the final model position Xe (referred to as R(e, Xe)) ( the element of the 1st row 2nd column is 

ic the partial differential sensitivity of the parameter c_ relative to the final model velocity Ve (referred to as R(c, Ve)), and 
the element of the 2nd row 2nd column is the partial differential sensitivity of the parameter e_ relative to the final model 
velocity e (referred to as R(e, Ve)). 

[0199] The program then proceeds to S1416 in which the timer is reset to zero and is started, to S1422, via S1418, 
S1420, in which it is determined whether the gait is to be switched. When the result is negative, the program proceeds 
75 toS1432. When the result is affirmative, on the other hand, the program proceeds to S1 428, via S1 424, S1 426, in which 
the gait mixing is conducted. 

[0200] Explaining this with reference to the flow chart of Figure 38 which shows the subroutine of the procedures, 
the program starts at S1500 in which the mixed gait parameters are generated using any method in the foregoing 
embodiments. At this time, one from among the standard gaits whose initial and final body positions and velocities are 
20 close to the demanded values, is selected as the base gait. Then, excluding the initial and final body positions and 
velocities from the directly-determined parameters, the mixed gait parameters are generated or calculated. The pro- 
gram then proceeds to S1502 in which the differences AxO, AvO, AXe, AVe between the initial and final body positions 
and velocities of the mixed gait and the demand values are calculated. 

[0201] The program then proceeds to S1504 in which the final position and velocity AXse, AVse are calculated as 
25 follows, by setting the model initial position and velocity to AxO, AvO, while setting the ZMP to 0. 

AXse = R(Xe, xO) * AxO + R(Xe, vO) * AvO 

AVse = R(Ve, xO) * AxO + R(Ve, vO) * AvO 

30 

[0202] The program then proceeds to S1506 in which the ZMP parameter correct on amount Ac, Ae are calculated 
as follows. 

Ac = R(c, Xe) * (AXe+AXse) + R(c, Ve) * (AVe+AVse) 

35 

Ac = R(e, Xe) * (AXe+AXse) + R(e, Ve) * (AVe+AVse) 

[0203] The program then proceeds to S1508 in which the ZMP parameters c, e are calculated using the same 
equation as was used in S1208. The program then proceeds to S1430, S1432, and to S1600 and S1602 in afbwchart 
40 of Figure 39 in which the procedures similar to those in the fourth embodiment are conducted. The program then pro- 
ceeds to S1604 in which the ZMP trajectory correction amount is calculated. This will be same as the pattern illustrated 
in Figure 28 if it is changed as c=Ac , e=Ae and the ZMP values at the braking points as 0. 

[0204] The program then proceeds to S1606 in which, setting the initial model position and velocity as 
xmdl(0) =Ax0 and vmdl(0)=Av0 and ZMPmdl = the aforesaid ZMP trajectory correction amount and by inputting 

45 them to the model, the behavior of the model is determined by sequential calculations. In other words, the current (at 
time t) model position and velocity are calculated using an equation of discretized model based on the preceding (at 
time t - At ) model position and velocity, and on the current (at time t) ZMP trajectory correction amount. In the first con- 
trol cycle, the current model position and velocity are set to xmdl(0) = AxO and vmdl(0) = AvO . As the discretized 
model, it is possible to use a model expressed in matrix form which is generally used in the field of modern control the- 

so ory. 

[0205] The program then proceeds to S1608 in which the model position is added to the mixed body position as a 
correction amount shown in the following equation, and the desired body position is thus determined. 

x(k) = xmix(k) + xmdl(kAt) 

55 

Here, x(k): the desired body position; xmix(k): the k-th datum in the body trajectory time-series data of the mixed gait; 
and xmdl(kAt): the model position at time kAt 

[0206] Having been configured in the foregoing manner, the system in the fifth embodiment can have the same 
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advantages as those of the fourth embodiment. 

[0207] To be more specific, since the linear Inverted pendulum model is used, the required capacity of memory 
(ROM 84) is less, and the body trajectory perturbation can be obtained on a real-time basis by sequential calculations, 
etc. Moreover, it is possible to easily obtain a strict solution of the model equation and based on the strict solution, it is 

5 possible to predict future behavior without difficulty. 

[0208] It should be noted that, although the sensitivities of the final body position and velocity relative to the ZMP 
parameters can be obtained from the strict solutions, since they include calculations of exponential functions, the sen- 
sitivities should preferably be obtained beforehand and stored in memory so as to reduce the calculation time. 
[0209] Figure 40 is a flow chart showing the operation of the system according to the sixth embodiment of the 

io present invention. 

[0210] As mentioned above, when the change of the inertial force of the free leg is negligible, in other words, the 
ZMP changes little, even if the initial free leg foot position or the final free leg foot position is perturbed, it is possible to 
simplify the gait generation. The sixth embodiment aims to achieve this. 

[021 1] In the gait defined in this specification, the final time of a gait is the instant at which the free leg lands. The 
75 ZMP has still been set at the floor-contact surface of the supporting leg foot. Accordingly, when the final free leg foot 
position is varied, the ZMP parameter need not be varied provided that the inertial force caused by the final free leg foot 
position change is negligible. However, since the initial position of the ZMP pattern is generally set at the toe of the initial 
free leg foot position and orientation, when the initial free leg foot position is changed, the ZMP pattern should therefore 
be varied in response thereto. 

20 [021 2] Taking the ZMP parameter change due to the initial free leg foot position change as an example, the opera- 
tion is now explained focusing on the difference from that of the fifth embodiment. 

[0213] The program starts in S1700 of the flow chart of Figure 40 and proceeds to S1710 in which similar proce- 
dures to those of the fifth embodiment are conducted, and then to S1712. The following procedures are added in the 
sixth embodiment in response to the ZMP parameter change so as to satisfy the dynamic equilibrium condition. 
25 [0214] Specifically, in S1 712, the behavior of the dynamic perturbation model is calculated up to the final time of the 
gait and the final model position Xe and the final model velocity Ve are calculated, setting the ZMP parameters c=0, 
e=0, p=1 , ZMP values at the other braking points = 0, while setting its initial states as xO = 0 and vO = 0, as illustrated 
in Figure 41 . 

[021 5] Then, the partial differential sensitivity of the final model position Xe relative to the ZMP parameter q, is cal- 
30 culated as follows. 

R(Xe, p) = Xe 

[0216] At the same time, the partial differential sensitivity of the final model velocity Ve relative to the ZMP param- 
35 eter p_, is calculated as follows. 

R(Ve, p) = Ve 

[0217] The program proceeds up to S1 728 in which similar procedures to those of the fifth embodiment are taken, 
40 and to Si 730 in which the gait mixing is conducted. Specifically, the program proceeds to S1800 as shown in a flow 
chart of Figure 42 in which the mixed gait parameters are generated using any method from the foregoing embodi- 
ments. At this time, one from among the standard gaits which is close in the initial and final body positions and velocities 
and the initial and final free leg foot positions and orientations is selected as the base gart. 

[021 8] Once selecting the base gait, the mixed gait is generated in the same manner as the foregoing embodiments 
45 by excluding the initial and final body positions and the initial and final free leg foot positions from the directly-deter- 
mined parameters. Consequently, the initial and final body positions and velocities and the initial and final free leg foot 
positions of the mixed gait are the same as those in the base gait. 

[021 9] The program proceeds to S1 806, via S1 802 and S1804, in which the difference between the demanded ini- 
tial free leg foot position and the mixed gait initial free leg foot position is calculated and is named Ap. The program then 
so proceeds to Si 808 in which, setting the initial model ZMP to Ap and ZMP values at the other braking points to 0, the 
final position and velocity AXpe, AVpe are calculated using the following equations. 

AXpe=R(Xe,p) * Ap 

55 AVpe=R(Ve,p) * Ap 

[0220] The program then proceeds to S1810 in which the ZMP correction amounts Ac, Ae are calculated using the 
following equations. 
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Ac = R(c, Xe) * (AXe+AXse+AXpe) + R(c, Ve) * (AVe+AVse+AVpe) 
Ae = R(e, Xe)*(AXe-hAXse+AXpe)+R(e, Ve)*(AVe+AVse+AVpe) 

5 [0221 ] The program then proceeds to S 1 732 of the flow chart of Figure 40 in which the aforesaid mixed gait param- 
eters are substituted for the desired gait parameters. The values obtained in S1812 is substituted for the ZMP parame- 
ters c, e. The demanded values are substituted for the initial and final free leg foot position parameters. 
[0222] The program then proceeds to S1734, as is shown in a flow chart of Figure 34 in which in S1900 and in 
S1 902 the same procedures as those of the fifth embodiment are conducted. With these procedures, feet trajectories 

10 which satisfy the demands for the initial and final free leg foot positions, as well as the corrected ZMP trajectory, are 
obtained. The program then proceeds to S1904 in which the ZMP trajectory correction amount is calculated. This is a 
pattern illustrated in Figure 44,in which its value c=Ac , e=Ae , p=Ap and the ZMP values at the other braking points 
are set to zero. 

[0223] The rest of the sixth embodiment is the same as the fifth embodiment 
is [0224] Having been configured in the foregoing manner, the system in the sixth embodiment has the same advan- 
tages as those in the fourth or fifth embodiment. Moreover, since standard gaits having different initial body position and 
velocity need not be stored in memory, the memory capacity can further be reduced. 

[0225] Figure 45 is a block diagram, similar to Figure 3, but showing the configuration of a system according to the 
seventh embodiment of the invention. The seventh embodiment differs in the calculation of the horizontal body position. 

20 [0226] In the seventh embodiment, the feet position and orientation, the ZMP and the body height Z at the current 
time (time t) and the states obtained (including body position and velocity) at the preceding time (time t-At), are input to 
a robot motion model (which is comprised of dynamics, kinematics and various conditions of constraint, in order that 
the current value (instantaneous values) of the horizontal body position coordinate (X, Y) be calculated. 
[0227] More specifically, in the seventh embodiment, S2000 to S2016 shown in a flow chart of Figure 46 are con- 

25 ducted similarly to the second embodiment. The program proceeds to S2100, then to S2104 as shown in a flow chart 
of Figure 47, and returns to the procedures shown in the flow chart of Figure 46. Then, the program proceeds from 
S201 8 to S2022 and then to S2200 and onward as shown in a flow chart of Figure 48 and to S2206 in which the mixed 
gait body trajectory (desired body trajectory) is determined by sequential calculation such that the ZMP dynamically cal- 
culated from the motion of the mixed gait body (desired body) and feet accords with the determined ZMP (which is 

30 determined from the mixed gait parameters). 

[0228] In the initial state of the gait, initial body position and velocity parameters, appropriately set, are used as the 
body position and velocity. Thus, gaits for a single waking step are generated by sequentially calculating values begin- 
ning from the initial body and velocity parameters. 

[0229] This method is disadvantageous in that the volume of calculation is increased and the final body position 
35 and velocity tend to deviate slightly from the demanded values, but is advantageous in that it can satisfy the dynamic 
equilibrium condition in a strict sense. 

[0230] In the seventh embodiment, the current body height and horizontal body position may alternatively be deter- 
mined such that they satisfy the dynamic equilibrium conditions and the constraint conditions for determining body 
height simultaneously. In the foregoing embodiments, the body height is calculated based on the preceding horizontal 
40 body position so as to shorten the calculation, assuming that the body height would not change greatly within a short 
period. 

[0231 ] The first to seventh embodiments are thus configured such that there is provided a system for generating a 
gait of a legged mobile robot having at least a body 24 and a plurality of leg links 2 each connected to the body through 
a joint 10R(L), 12R(L), 14R(L), comprising standard gait storing means (S10, etc.) for storing, in memory, a plurality of 

45 standard gaits, for at least one walking step, each comprising a set of parameters including a parameter relating to a 
floor reaction force, gait demanding means (S24, etc.) for making a demand for gait, and gait generating means (S26 
to S30.S100 to S106, S200 to S206, etc.) for generating an approximated gait which satisfies the demand for gait by 
selecting one or a plurality of the standard gaits in response to the demand for gait, and by conducting approximation 
based on the selected standard gait or gaits. 

so [0232] It is configured such that said gait generating means generates the approximated gait by calculating a 
weighted average of the selected gaits (S100 to S106, S200 to S206, etc.). 

[0233] It is configured such that said gait generating means generates the approximated gait by using a parameter 
sensitivity of the selected gait or gaits (S500, S600 to S604, S700 to S706). 

[0234] It is configured such that said gait generating means generates the approximated gait by calculating a 
55 weighted average of the selected gaits and by using a parameter sensitivity of the selected gait or gait (S800, S900 to 
S906, S1000 to S1006). 

[0235] It is configured such that said gait generating means includes storing means (S500, S800, etc.) for deter- 
mining an amount of change in one parameter relative to a unit amount of change in another parameter in at least one 
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of the standard gaits, as the parameter sensitivity of the selected gait and for storing the parameter sensitivity in mem- 
ory, and generates the approximated gait by using the stored parameter sensitivity. 

[0236] It is configured such that said gait means incudes describing means (S1 1 04 to S1 1 1 4) for describing a rela- 
tionship of perturbation of one parameter relative to the parameter relating to the floor reaction force in the standard 
gaits, and corrects the approximated gait based on the described relationship of perturbation to generate gaits which 
satisfy the demand for gait in such a manner that at least displacements and velocities in the generated gaits are con- 
tinuous at a boundary of the gaits (Si 128, S1200 to S1208, S1130, S1 132, S1300 to S1304, etc.). 
[0237] It is configured such that the perturbation of the one parameter is a perturbation of a horizontal body posi- 
tion. 

[0238] It is configured such the relationship is described by a linear model. 

[0239] It is configured such that the relationship is described by an inverted pendulum model. 

[0240] It is configured such that the relationship is described by time-series tabulated data. 

[0241] It is configured such that said gait generating means generates the approximated gait, without considering, 

(i.e., irrespectively of) the parameter if the parameter is under a predetermined condition (S1 730, S1 800 to S1 812). 

[0242] It is configured such that said gait generating means includes joint angle command calculating means 

(S302) for calculating a joint angle command of the robot based on the generated gait, and joint controlling means 

(S306) for controlling the joint of the robot such that it traces the calculated joint angle command. 

[0243] It is configured such that said joint angle command calculating means includes detecting means (S300, 

S400 to S404) for detecting a state of the robot, and correcting means (S406, S408, S304) for correcting a position and 

a posture of the robot in response to the detected state, and calculates the joint angle command such that the corrected 

position and the orientation are effected. 

[0244] In the first to seventh embodiment, the approximation should not be limited to those disclosed. Rather, var- 
ious modification or alteration will be possible. 

[0245] In the first to seventh embodiments, the body position is represented by a coordinate of a reference point of 
the body 24 viewed in the coordinate system set at the supporting leg's floor-contact point The reference point should 
be set at the center of the body 24 in the left and right direction. As regards the to-and-fro direction, the reference point 
can be set using any of the following methods. 

Method 1 ) to set the reference point at the center of gravity of the body (used in the first to seventh embodiments). 
Method 2) to set the reference point at the position which will accord with the center of mass of the robot when the 
robot stands upright. 

Method 3) to set the reference point at an appropriate point by trial and error. 

[0246] Any of the methods would not differ if the orientation of the body is constant during walking. However, if the 
body orientation changes during walking such as in turning, an error (approximation error) would be different depending 
on the location where the reference point is set. More specifically, Figure 49 illustrates the cases in which the reference 
point is set at the center of the body, and the reference point is shifted right in the sheet Assume a situation where the 
body is rotated about the reference point, it will be understood that the body positions are different from each other if 
the reference point is at the body center, or if the reference point is close to the body front. 

[0247] The generation of a mixed gait (demanded gait) has been described taking an example of mixing gaits hav- 
ing different turning angles. The gait mixing is thus a kind of approximation. However, the gait will vary slightly depend- 
ing on the way of setting of the reference point, as mentioned above, and hence, the accuracy of approximation relative 
to the dynamic equilibrium condition will vary. 

[0248] The reference point should accordingly be set such that the error relative to the dynamic equilibrium condi- 
tion is as small as possible. Which of the setting methods is optimal or any of the setting method affects little depends 
upon the structure or the nature of walking of the robot. 

[0249] In order to enhance the accuracy relative to the dynamic equilibrium condition, it is alternatively possible to 
use, instead of the time-series tabulated data of body position, time-series tabulated data of the center of mass of the 
robot. If doing so, since the robot posture must be determined such that the center of robot mass accords with a desig- 
nated position, the volume of calculation will be increased by a significant amount. 

[0250] In the foregoing embodiments, the acceleration has not been described in the gait parameters. Needless to 
say, generated gaits will be even smoother if the acceleration is made continuous at the boundary of gaits. 
[0251 ] In the foregoing embodiments, although the present invention has been described with reference to a biped 
robot, the present invention can be applied to other legged mobile robots. 

INDUSTRIAL FIELD IN WHICH THE INVENTION IS APPLICABLE 

[0252] According to the present invention, it becomes possible to generate gaits including the floor reaction force 
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freely on a real-time basis and to effect a stride or a turning angle as desired. Moreover, it becomes possible to make 
the displacements and velocities of various robot portions continuous at the boundary of the generated gaits. Further- 
more it becomes possible to control walking of a legged mobile robot based on the gaits generated on a real-time basis. 



Claims 

1 . A system for generating a gait of a legged mobile robot having at least a body and a plurality of leg links each con- 
nected to the body through a joint, comprising 

a. standard gait storing means for storing, in memory, a plurality of standard gaits, for at least one walking step, 
each comprising a set of parameters including a parameter relating to a floor reaction force; 

b. gait demanding means for making a demand for gait; and 

c. gait generating means for generating an approximated gait which satisfies the demand for gait by selecting 
one or a plurality of the standard gaits in response to the demand for gait, and by conducting approximation 
based on the selected standard gait or gaits. 

2. A system according to claim 1 , wherein said gait generating means generates the approximated gait by calculating 
a weighted average of the selected gaits. 

3. A system according to claim 1, wherein said gait generating means generates the approximated gait by using a 
parameter sensitivity of the selected gait or gaits. 

4. A system according to claim 1 , wherein said gait generating means generates the approximated gait by calculating 
a weighted average of the selected gaits and by using a parameter sensitivity of the selected gait or gaits. 

5. A system according to claim 3 or 4, wherein said gait generating means includes; 

d. storing means for determining an amount of change in one parameter relative to a unit amount of change in 
another parameter in at least one of the standard gaits, as the parameter sensitivity of the selected gait and for 
storing the parameter sensitivity in memory; 

and generates the approximated gait by using the stored parameter sensitivity. 

6. A system according to any of preceding claims 1 to 5, wherein said gait means incudes: 

e. describing means for describing a relationship of perturbation of one parameter relative to the parameter 
relating to the floor reaction force in the standard gaits; 

and corrects the approximated gait based on the described relationship of perturbation to generate gaits which 
satisfy the demand for gait in such a manner that at least displacements and velocities in the generated gaits 
are continuous at a boundary of the gaits. 

7. A system according to claim 6, wherein the perturbation of the one parameter is a perturbation of a horizontal body 
position. 

8. A system according to claim 6 or 7, wherein the relationship is described by a linear model. 

9. A system according to claim 8, wherein the relationship is described by an inverted pendulum model. 

10. A system according to claim 6 or 7, wherein the relationship is described by time-series tabulated data. 

11 . A system according to any of claims 1 to 10, wherein said gait generating means generates the approximated gait 
by excluding the parameter if the parameter is under a predetermined condition. 

12. A system according to any of preceding claims 1 to 11 , wherein said gait generating means includes; 

f . joint angle command calculating means for calculating a joint angle command of the robot based on the gen- 
erated gait; and 

g. joint controlling means for controlling the joint of the robot such that it traces the calculated joint angle com- 
mand. 
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13. A system according to claim 12, wherein said joint angle command calculating means includes; 

h. detecting means for detecting a state of the robot; and 

i. correcting means for correcting a position and an orientation of the robot in response to the detected state; 
and calculates the joint angle command such that the corrected position and the orientation are effected. 



1018467A1J > 



25 



EP1 018 467 A1 



FIG.l 



I INCLINATION SENSOR . ! 




3NSDOCID: • tP 



.1018467A1J. > 



EP1 018 467 A1 



FIG.2 



26 



1ST 

CALCULATOR 



0 70 



2ND 

CALCULATOR 



<9£ 



72 
84 



ROM 



l/ 



74 



RAM 



A/D 



76 



COUNTER 



86 



D/A 



JOYSTICK -62 



INCLINATION 
SENSOR 



-60 



6- AXIS FORCE 
AND TORQUE 
SENSOR 



-44 



ROTARY 
ENCODER 



MOTOR 



SERVO- AMPLIFIER 



27 



)NSDOC!0 <E= 1018467A1 I > 



EP 1 018 467 A1 



FIG.3 



111 



INVERSE 
KINEMATICS 


CALCULATOR 


~r 


* 






DOUBLE-LEG 


CONTROLLER 




28 



RNSDCCID: -:EP 



1018467A1 I > 



EP1 018 467 A1 



FIG. 4 



( START ~~) 



c 



S10 



STORE STANDARD GAITS PREPARED BY OFFLINE COMPUTER IN MEMORY 



CALCULATE AND STORE FINAL BODY POSITIONS \/ 
AND VELOCITIES IN STANDARD GAITS 



t =0 



S16 



END 



S12 



WAIT FOR TIMER INTERRUPT (AT EVERY CONTROL CYCLE) / 



S18 



A 



20 



yes 



AT G ATT 
SWITCHING 



t = 0 



S24 



READ DEMANDED VALUES FOR DIRECTLY- 
DETERMINED PARAMETERS IN NEW CURRENT 
GAIT 



CONDUCT PROCEDURES FOR GAIT 
MIXING (SELECT STANDARD GAITS 
TO BE MIXED AND DETERMINE 
WEIGHTS, AND GENERATE MIXED 
GAIT PARAMETERS) 



/ 



S26 



S28 



SUBSTITUTE MIXED GAIT PARAMETERS 
(TABULATED DATA) FOR DESIRED GAIT 
PARAMETERS (TABULATED DATA) 



CONDUCT PROCEDURES FOR 
CALCULATING NSTANTANEOUS 
VALUES OF DESIRED GAIT 

t-t+At 



/ 



S30 



-S32 



___1018467A1 I 



29 



EP1 018 467 A1 



FIG. 5 



STANDARD GAIT NO. 0 



INITIAL FREE 
LEG POSITION 
AND 

ORIENTATION 



FINAL FREE 
LEG POSITION 

(LEFT) AN 0 

ORIENTATION 



□ 



X(TO) 



SUPPORTING 
LEG POSITION 
AND 

ORIENTATION 



FIG. 6 



UPWARD 




FREE LEG FOOT SUPPORTING 
LEG FOOT 



30 



EP1 018 467 A1 



FIG. 7 



Xzmp 



INITIAL FREE 
LEG TOE 
POSITION 1 



SUPPORTING 
LEG HEEL 
POSITION 




DOUBLE-LEG SUPPORTING 
PHASE ^ 

FREE LEG HEEL 
LIFTING 

SUPPORTING LEG 
HEEL LANDING 



t 



SINGLE-LEG 

SUPPORTING 

PHASE 



TIME 



TIME 



FREE LEG TOE 
LIFTING 

SUPPORTING LEG TOE 
LANDING 



FREE LEG HEEL 

LANDING 

SUPPORTING 

LEGHEEL 

LIFTING 



FIG. 8 



STANDARD GAIT NO. 1 



INITIAL FREE LEG 
POSITION AND 
ORIENTATION 



bO 




01 



FINAL FREE LEG POSITION 
AND ORIENTATION 



□ 



3 — * 



(TO) 



SUPPORTING LEG POSITION 
AND ORIENTATION 



3N3DOC!C.\ <t P.. _. 1018467A1.I > 



31 



EP 1 018 467 A1 



FIG.9 



SUPPORTING 
LEG HEEL 
POSITION 



Xzmp t 



INITIAL FREE 
LEG TOE POSITION P 
Y 



tl t2 




DOUBLE-LEG 
SUPPORTING 
PHASE 



Cl 



dl 



t4 



4- 

TIME 



TIME 



SINGLE-LEG 
SUPPORTING PHASE 



FIG. 10 



STANDARD GAIT NO. 2 



INITIAL FREE LEG 
POSITION AND ORIENTATION 



bZ 



o=a0 \ 



FINAL FREE LEG POSITION 
y(LHM7 AND ORIENTATION 



□ 



X CTO) 



SUPPORTING LEG POSITION 
AND ORIENTATION 



32 



EP1 018 467 A1 



FIG. 1 1 



Xzmp 



0 



INITIAL FREE 
LEG TOE 
POSITION 




Yzmp 



SUPPORTING 
LEG HEEL 
POSITION 

tl t2 



c2 



T 



d2 



t4 



t3 



DOUBLE-LEG 
SUPPORTING 
PHASE 



L 



TIME 



u 



TIME 



SINGLE-LEG 

SUPPORTING 

PHASE 



FIG. 12 

DEMAND GAIT (3RD GAIT) 



INITIAL FREE 
LEG POSITION 
AND 

ORIENTATION 




Y (LEFT) FINAL FREE LEG 

| —l POSITION AND 

I I ORIENTATION 



X ( TO) 



SUPPORTING LEG 
POSITION AND 
ORIENTATION 



•NSDOCIO <E° 1018467A1 I > 



33 



EP1 018 467 A1 



FIG. 13 
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FIG. 22 
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FIG. 23 
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FIG. 25 
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